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This paper concerns the forward kinematics and tension dis- 
tribution of sinking winches mechanism, which is a type of 
four-cable-driven partly constrained parallel robot. Conven- 
tional studies on forward kinematics of cable- driven parallel 
robot assumed that all cables are taut. Actually, given the 
lengths of four cables, some cables may be slack when the 
platform is in static equilibrium. Therefore, in this paper, 
the tension state (tautness or slackness) of cables is consid- 
ered in the forward kinematics model. We propose Traversal- 
Solving-Algorithm, which can indicate the tension state of 
cables, and further determine the pose of the platform, if the 
lengths of four cables are given. The effectiveness of the al- 
gorithm is verified by four examples. The results of this paper 
can be used to control sinking winches mechanism to achieve 
the level and stable motion of the platform, and to make the 
tension distribution of cables as uniform as possible. 
Keywords: forward kinematics, tension distribution, sinking 
winches mechanism, cable-driven parallel robot 

1 Introduction 

In the coal mining industry, constructing a vertical shaft to 
transport miners and equipment down to a mine (and also 



to lift coal out of it) is the fist step to mine the coal. The 
main equipment to construct a vertical shaft is a sinking 
winches mechanism, as shown in Fig. [TJ which consists of 
four winches, four cables, a derrick and a platform. The plat- 
form, supplying the workspace for constructors, needs to be 
lowed down in digging process (or lifted up when cast the 
wall of the shaft) by rolling out (or rolling in) four cables on 
the winches. 

The lengths of four cables from the winches to the plat- 
form determines the pose of the platform; the platform will 
remain horizontal if these lengths are equal. It is crucial 
to synchronize the motion of the winches so as to keep the 
platform leveled horizontally during operation, since a tilted 
platform in motion may collide with the wall of the shaft. 
However, the absolutely synchronized motion of the winches 
is impossible, and there always exists synchronization error 
(length difference of cables). To avoid the collision of the 
platform and shaft wall, length difference of cables must be 
limited. To obtain the limitation of the length difference re- 
quires the determination of the pose of the platform given 
the lengths of four cables. This is the forward kinematics 
problem that we address in this paper. 

A sinking winches mechanism can be considered as a 




Fig. 1 . Sinking winches mechanism 

cable-driven partially constrained parallel robot. The for- 
ward kinematics of parallel robots with rigid active links has 
been studied by many researchers. In addition to the well 
established methods (e.g., the elimination method HIEIG), 
the continuation method [4, 5|, the Groebner basis method 
0I3 and the interval analysis method O), new approaches 
for dealing with this problem have been developed recently. 
These include methods based on neural networks |9), dif- 
ferential evolution ITOl . and meta-heuristic search technique 
ifTTll . and the Gauss-Newton iterative method based on chaos 
and hyper-chaos fi2l . 

For forward kinematics of cable-driven parallel robots, 
few results are available. Most studies focused on deter- 
mining the pose of the end-effector of a cable-driven fully 
constrained parallel robot. This is generally accomplished 
by solving the forward kinematics equations using numeri- 
cal method (such as Newton-Raphson method Ifl3l ) and ana- 
lytical method based on the tetrahedron characteristic of the 
mechanism lfT4l[T3l[T6l . and only one solution was solved. 
Using the tool of interval analysis, Merlet ifTTl obtained 
multiple solutions for the forward kinematics equations of 
a robot named MARIONET. 

Compared to cable-driven fully constrained parallel 
robots, partially constrained parallel robots (usually suspend- 
ing a platform as the end-effector) represent a more difficult 
case in forward kinematics analysis. This difficulty arises 
mainly from the fact that static equilibrium equations of 
the platform needs to be included in the forward kinematics 
model fl"8l . Merlet et al (l9l studied the forward kinemat- 
ics problem of a four-cable-driven parallel robot, which had 
the similar configuration with the sinking winches mecha- 
nism described in Figure Q] and obtained multiple poses of 
the platform by interval analysis; however, the multiple poses 
were solved based on assumption that all cables are taut. This 



assumption is usually unpractical since, arbitrarily giving the 
lengths of four cables, the platform may be suspended by 
one, two, three, or four cables when the platform is in static 
equilibrium. Therefore, the tension state (tautness and slack- 
ness) of cables must be taken into account in the forward 
kinematics analysis. To investigate the forward kinematics 
of a sinking winches mechanism in this context is the main 
focus of this paper. 

The remainder of this paper is organized as follows. 
Section 2 establishes the forward kinematics model of the 
sinking winches mechanism. Section 3 presents our methods 
for solving the forward kinematics problem, while Section 4 
discusses the solving procedure. Section 5 presents four ex- 
amples. Section 6 summarizes the results, and discusses their 
implications. 



2 Forward Kinematics Model 

In this section we construct a forward kinematics model 
of a sinking winches mechanism driven by four cables. This 
model addresses geometrical constraints and static equilib- 
rium; it incorporates the tension state, but ignores the masses 
and the elasticity, of the cables. 

2.1 Description of the Sinking Winches Mechanism 

As shown in Fig. [T] the pose of the platform is deter- 
mined by the lengths of the four cables, each extending from 
a tangent point on the head sheave to an attachment point 
on the platform. Fig. [2] illustrates the relationship between 
the cable lengths and the pose of the platform, where A, and 
Bj, (i = 1,2,3,4) are the tangent and attachment points, re- 
spectively, and A1A2A3A4 and B1B2B3B4 are identical rect- 
angles with sides of 2a and 2b. An inertial frame (oxyz) is 
defined at the centroid of A1A2A3A4, while the local frame 
(OXYZ) is located at the centroid of B1B2B3B4. Hence, the 
coordinates of B t in the local frame are identical to those of 
A,, with i G {1,2,3,4}, in the inertial frame; these coordi- 
nates are: (a,b,Q), (—a,b,0),(—a,—b,0) and (a,—b,0). In 
the local frame, the platform's center of gravity, denoted by 
C, is (k\a 1 k2b, —h), where k\,k2 € (—1,1). The geometrical 
parameters of the sinking winches mechanism are: a = 2 m, 
b = 2.5 m, h = 10 m, k\ = 0.25 and k2 = 0.2. The mass of 
the platform is m = 10 4 kg. 

The pose of the platform is represented by the Cartesian 
coordinates of B\, B2, B3 and C in the inertia frame. Since 
B\,B2,Bj, and B4 are coplanar and form a rectangle, the co- 
ordinates of B4 can be expressed in terms of the other three 
points as follows: 

B 4 =B l B 2 +B 3 . (1) 

2.2 Geometrical Constraints 

The equations describing the geometrical constraints in- 
herent in the sinking winches mechanism are expressed in 
terms of the coordinates of B\, B2, Bj and C. These con- 
straints can be classified into two groups. The first group 
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Fig. 2. Reduced configuration of sinking winches mechanism 



describes the fixed distances among B\, B 2 , B3 and C, i.e. 
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where, r\, r 2 and r 3 denote the distances from C to B\, B2 
and B3, respectively, and can be calculated as follows: 
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The second group of constraint equations express the 
lengths of taut cables in terms of the coordinates of B\, B 2 
and B3. When in static equilibrium, the platform can be sus- 
pended by one, two, three, or all four cables. If the platform 
is suspended by a single cable, then the length of that cable 
can be expressed as 



\A i B i \=l i »€ {1,2,3,4}, 



(3) 



where /, denotes the length of cable ;. Similarly, if the plat- 
form is suspended by two, three or four cables, then the con- 
straint equations are 



\AiBi\=l u \AjBj\ = lj 
{1,2,3,4},^ j; 



(4) 



lAiB^h, \AjBj\=lj, \A k B k \=l k 
i,j,k£{l,2,3,4},i¥=J¥=k; 



\A t Bi\ = l i: i = 1,2,3,4. 



(5) 



(6) 



Clearly the second set equations are determined by the ten- 
sion state of the cables. 



2.3 Static Equilibrium 

The platform is in static equilibrium under its external 
wrench (F) and the tension of cables (T). The static equilib- 
rium can be expressed as ifTTl : 



J 1 T =F, 



(7) 



where J T is the structure matrix of sinking winches mecha- 
nism, and denoted as 



Ml «2 «3 «4 

CB\ x mi CB 2 x u 2 CB3 x h 3 CB4 x 114 



, (8) 



where u, is the unit vector of A,fi,, and calculated by 
AiBi/lAtB.l 

Since only gravity is applied on the platform, exter- 
nal wrench can be expressed as F = [0,0, — m^,0,0,0] T . 
It should be emphasized that the tension vector T = 
[Xi,z 2 ,Z3,Z4] T , where T, is the tension of i th cable, is de- 
termined by the tension state of cables: if the i th cable is 
slack, Tj must be zero. 

To sum up, an example can illustrate how to construct 
the forward kinematics model of sinking winches mecha- 
nism. Supposing cables ®, (J) and (3) are taut when the plat- 
form is in static equilibrium with the given lengths of four ca- 
bles, Eqn. ©, Eqn. © (with i= l,j = 2,k = 3) and Eqn. © 
(with T = [xi ,T2,i3, 0] T ) build up the forward kimematics 
model. We totally obtain 15 nonlinear equations with 15 un- 
knowns, which are tensions (xi ,T 2 , X3) and coordinates of B 1 , 
B 2 , Bj and C. Clearly, the second geometrical constraints 
Eqn. {5]i and static equilibrium Eqn. © are determined by 
tension state of cables. 



3 Solving the Forward Kinematics 

As described in section|2] the forward kinematics model 
of sinking winches mechanism is constructed by a system of 
nonlinear equations. There exists at most six reasonable so- 
lutions for these equations since, for sinking winches mech- 
anism, maximum six configurations (shown in Fig.O satisfy 
the condition that the platform is in static equilibrium. How- 
ever, this paper isn't dedicated to all reasonable solutions but 
focuses on the solution in the context of the first configura- 
tion (see Fig. |3(a)| i, because it is the actual configuration of 
sinking winches mechanism. 
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Fig. 3. Multiple configurations of SWM 



It is hard to analytically solve these nonlinear equations, 
since the number of equations is at least 13 (if one cable is in 
tension). Thus, numerical method Trust-Region Dogleg Al- 
gorithm is selected to solve them. However, there exists three 
cases that cause the numerical algorithm non-convergence, 
or converge to wrong solutions, which are listed as follows. 

1) Single cable suspends the platform; 

2) Four cables have equal lengths; 

3) Adjacent cables have equal lengths. 

The following sections give detailed analysis on reasons and 
propose some approaches to overcome them. 



3.1 Single Cable Suspending the Platform 

If a cable is much shorter than other three cables, the 
platform may be solely suspended by the shortest cable when 
it is in static equilibrium. Without loss of generality, we as- 
sume that the platform is suspended by cable Q, and ca- 
bles (2), (3), @ are slack; the tension vector is expressed as 
T = [z\ , 0, 0, 0] T . When the platform is in static equilibrium, 
the tangent point (A\), attachment point (Z?i), and the plat- 
form's center of gravity (C) form a plumb line, since external 
wrench applied on the platform only includes gravity. Sub- 
sequently, in inertial frame, the coordinates of B\ and C are 
(a,b,—li) and (a,b,—l\ — r\). Thus, U\ = A\B\/\A\B\\ = 
[0,0, — 1] T and CB\ x«i=0, since CB\ and«i are collinear; 
the static equilibrium equation is expressed as 



U • [0, 0, - 1 , 0, 0, 0] T = [0, 0, -mg, 0, 0, 0] 1 



(9) 



Equation (0 can be reduced as Ti = m- g, and the effective 
number of Eqn. (0 is reduced form six to one. Combining 
Eqns. (0, (0 and (0, we end up with eight effective equa- 
tions for the model of forward kinematics with thirteen un- 
knowns. The insufficient equations for unknowns causes the 
ineffective and uncorrect convergence of Trust-Region Dog- 
leg Algorithm. 

The insufficient equations for unknowns also results in 
multiple solutions existing for coordinates of Z? 2 and B3, 
since tension Ti and coordinates of B\ and C are definite. 
Therefore, the pose of the platform is not definite (or out 
of control) if the platform is suspended by single cable. This 
motivates us to propose the criteria to check whether this case 
happens with the given lengths of four cables; furthermore, 
we can avoid this case by control the lengths of cables. 

In fact, if the platform is suspended by single cable, the 
other three slack cables allow the platform freely rotating 
around the single cable within a rotational range. Therefore, 
whether single cable suspends the platform can be deduced 
by checking if the rotational range exists. We first define crit- 
ical lengths of slack cables, and then illustrate the criteria. 

3.1.1 Critical Length 

Assuming that cable @ is shortest and solely suspend 
the platform, we define the critical lengths of cables (2), (3) 
and @ as follows. 

1) Rotating the platform around cable ® (line A\B\) by 271, 
the trajectory of Bo is a circle with its center locating at 
line A \ B \ , as shown in Fig . |4l 

2) Arbitrarily select a point Bo on the circle, let di be the 
normal vector from Bo_ to line A \ B \ , and 9? is the included 
angle of d.2 with respect to x-axis of inertial frame; 

3) The distance of A2B2 is a function of 9?, and denoted as 
Z 2 (9 2 ) = |A 2 B 2 |; 

4) We define / 2m j n = min[/ 2 (9 2 )] and / 2max = max[/ 2 (9 2 )] as 
the minimal and maximal critical length of cable (2), re- 
spectively. 



The same definitions can be made for cables ( 
which are denoted as Z 3min , / 3max , / 4min and Z 4max . 



and 
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Fig. 4. Critical lengths of cable 2 

Next we deduce the values of hmin and hmax- Based on 
geometry, the /2mm an d hmax are available only if A\B\ and 
A2B2 are coplanar. As shown in Fig. @] let B21, B22 be the 
intersections between the circle trajectory of B2 and the co- 
plane determined by A\B\ and A2B2, coordinates of B21 and 
B22 are solved by the following equations 



(AifiixS 1 fi 2 )x(A 2 fi2xfiiB2) 

\BiB 2 \ = 2a 

\CB 2 ]=r 2 







And the coordinates of B21 and B22 are solved as 



(10) 



and 



xzi = a - ^/4a 2 - [(rj - 4a 2 - r\)/(2 n )] 2 
yi\ — b ■■ 

{Z2i = (r 2 2 -4a 2 -r 2 l )/(2r 1 )-h 



x 22 = a+ ^4a 2 -[(r 2 -4a 2 -r 2 )/(2r l )] 
yi2 = b 

Z22 = {r\-4a 1 -r\)l{2r x )-h 



Finally, with the fixed coordinates of A 2 {— a,b,Q), the mini- 
mal and maximal critical lengths of cable (J) are calculated as 
hmin = I-A2B21 1 and hmax = \^B%2 1- And the critical lengths 
of cables (3) and @ can be solved by similar approach as 
cable (2). 

3.1.2 Criteria 

As discussed previously, the platform is solely sus- 
pended by the shortest cable Q if the lengths of cables (2), 
(3) and (4) allow the platform freely rotating around cable Q 
within a rotational range. This criteria can be mathematically 
described as: let <(» 9 , <t> 3 and <(» 4 be the rotational ranges that 
the cables (2), (3) and @ respectively allow the platform ro- 
tating around cable Q; define <|> = <t> 2 H03 the platform 
is solely suspended by cable ® if $ is not empty. 

From the definition of critical length, we conclude: 



1) If lj < lj m in, j G {2,3,4}, the platform is not solely sus- 
pended by cable Q, since cable j does not allow the plat- 
form freely rotating around cable ® if the length of cable 
j is less or equal to its minimal critical length, i.e., <(> = 0; 

2) If lj > I 

;maxi j — 2,3,4, the platform is solely suspended 
by cable ® , since the platform can rotate around cable Q 
by 2k if the three cables ((2),(3),@) are larger or equal to 
their maximal critical lengths, i.e., <|> = [0,27t]. 

However, what if lj € ((/mini^/'max ), j G {2,3,4}? In these 
cases, tyj, j e {2,3,4} need to be calculated respectively to 
deduce whether <|> is empty. And <(» 7 can be calculated as 
follows. 

1) Suppose the platform rotating around cable Q by 8 from 
a initial pose; 

2) Calculate the distances of AjBj, j £ {2,3,4}, which are 
expressed by lj(Q); 

3) The rotational ranges <|> ; are solved by the inequality 
0(0) < lj with G [0,27t], since the distance of AjBj is 
less or equal to the length of cable j if 8 G <t> ; . 

The following gives detailed description on above approach. 

Supposing the platform rotates around cable by 
from the initial pose that minimal critical length of cable (2) 
is available, as shown in Fig. [5] we calculate the distance 
/ ; (0) = |A ; \B 7 '|, j G {2,3,4}. Since the coordinates of fixed 
points Aj are known, we just need to express the coordi- 
nates of Bj in term of 0. At the initial pose, we define dj, 
j G {2,3,4}, the normal vector from point Bj to line A\B\, 
whose magnitude is dj, and included angel with respect to 
x-axis is ; . If the platform counterclockwise rotates by 0, 
the coordinates of Bj, j G {2,3,4}, are expressed as 



Xj =a + djCos(Qj + 0) 



b + djSm(Bj + Q) 



(11) 



since the trajectory of Bj is a circle around A \B\ in parallel 
with plane xoy; and Zj keeps the same during the rotation of 
the platform. 

In the following, we calculate dj, Qj and zj, j G {2,3,4}, 
when the platform is at the initial pose. At the initial pose, 
the coordinates of B\ are (a,b,—l\), B2 are expressed in 
Eqn. ([Tol l. The coordinates of B3 are solved by the following 
equations 



|*i*3 1 =2Va z + b 2 
\B 2 B 3 \=2b 
\CB 3 \=r 3 

There exists two set of solutions for coordinates of £3, and 
select the set of solutions satisfying the initial pose as 

x 3 = [3a 2 +xl l + (zi-Z2i) 2 -(zi + li) 2 }/[2(x 2 i-a)} 
>'3 = b- v/4a 2 + Ab 2 - (z 3 + h ) 2 - (*3 - a) 2 
Z3 = [(rj - 4a 2 - 4b 2 - r 2 )]/(2n ) - h 




Fig. 5. Initial pose of the platform 

Subsequently, the coordinates of B4 are calculated by sub- 
stituting the coordinates of B\, B2 and B3 into Eqn. ([T). At 
this point, the coordinates of B;, i £ {1,2,3,4}, have been 
calculated, and zu j £ {2,3,4}, can be expressed as 



Z 2 = (rl-4a 2 -r\)/{2n)-h 
Z3 = (r 2 - 4a 2 - 4b 2 - r\ )/(2n) - h 
Z4 = (r 2 -r 2 ~4b 2 )/{2n)-h 



With the coordinates of the fixed point A\ and B,, i £ 
{1,2,3,4}, dj and ; -, j £ {2,3,4}, can be calculated based 
on analytical geometry. Let B'j be the projection point of Bj 
on line A\B\, and the coordinates of B • in the initial frame 
oxyz can be calculated as follows: 



B 1 : = B\+B\A\ 



B\A\ B\B 



IfliAip 



j G {2,3,4}. 



It should be noted that above criteria is proposed based 
on the assumption that cable ® is shortest. For other situa- 
tions, such as cable (2) (or (J), or @) is shortest, we can take 
the similar analysis. Moreover, to avoid single cable sus- 
pending the platform, the lengths of cables should be con- 
trolled so as to guarantee the rotational range (|) is empty. 

3.2 Four Cables Having Equal Lengths 
3.2.1 Pose of Platform and Tension of Cables 

For sinking winches mechanism, if four cables have 
equal length /, the platform will remain horizontal and stay 
at the pose that tangent point (A,) and attachment point 
(Bj) of cable i,i £ {1,2,3,4}, form a plump line. At this 
pose, the coordinates of Bf,i £ {1,2,3,4} and C in inertial 
frame are (a,b,—l), (—a,b,—l), (—a, —&,—/), (a,—b,—l) 
and (k\a 1 k2b, —I — h), respectively. At this point, the pose of 
the platform is obtained. 

With the coordinates of B,,/ € {1,2,3,4} and C, the vec- 
tors h, and CBj can be calculated, which are introduced into 
Eqn. (0, and the structure matrix J T is obtained. Substitut- 
ing / T into Eqn. the static equilibrium of the platform is 
expressed as: 
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There are infinite solutions for above equation, since the 
ranks of J T and [/ T |F] are both three while the number of 
unknowns are four. That is why Trust-Region Dogleg Algo- 
rithm can't converge effectively and correctly. However, the 
above equation can be analytically solved as 



Thus, the normal vector is expressed as dj = Bj—B'j, whose 
magnitude dj and angles Qj can subsequently calculated. 
Substitution of dj, ; -, and Zj into Eqn. (fTTI i yields coordi- 
nates of Bj in term of 0. Consequently, the distance L-(9) can 
be expressed by lj(Q) = \AjBj\, 

With the expression of lj(B), j £ {2,3,4}, the rotational 
range (j)^ can be solved by the inequality lj(Q) < lj with 
9 £ [0,27t]. To solve the inequality, we first solve the equa- 
tion //(9) = lj with £ [0,27t]. The equation with an interval 
can be solved by interval analysis ||201|2T1 . And two solu- 
tions exist in the interval, which are denoted as 02 1 and ©22 
with 02i < 022- Thus, the interval [0,27t] is separated into 
three sub-intervals [O,02i], [021,022] and [022, 2k]. The solu- 
tions of the inequality lj{Q) < lj are selected from the three 
sub-intervals by midpoint method, i.e., the sub-interval is the 
solution of the inequality if the its midpoint satisfies the in- 
equality. And rotational range <(> 7 -, j £ {2,3,4} is obtained, 
thus, <|> = <(>2 0^3 H04- We can deduce whether the platform 
is solely suspended by cable ® by checking if is empty. 
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(12) 



Considering that the tension of cables are non-negative, 
i.e., X > 0, from which we deduce the value of T4 is limited 
in the following intervals. 

1) [0,(l-k 2 )mg/2] if {h £ (-1,1), k 2 £ (0,1), N < |Jt 2 |); 

2) [0,(l+ki)mg/2] if (*i G (-1,0), k 2 £ (-l,l),|*i| > 

m, 

3) [(ki -kz)mg/2 t (l+ki)mg/2] if (k\ £ (-l,l),fe e 
(-l,0),|ti|<N); 

4) [(Jfc! -k 2 )mg/2,(l -k 2 )mg/2] if (Jfcj £ (0,1), k 2 £ 

(-l,l),|*i|>N). 

As can be seen, the coefficients k\ and ^2 determine the range 
of T4, subsequently the tension scales of all cables, but can 



not determine a definite tension distribution. Meanwhile, k\ 
and Ic2 also describe the location of center of gravity (C) on 
the platform, more specially, the X and Y coordinates of C in 
local frame as (k\a 1 k2b), E (—1,1). Therefore, loca- 
tion of center of gravity affects the tension scales of all ca- Q 
bles. Among the tension scales, we are interested to the even ~ 
tension distribution, i.e., tension difference among cables is .1 
minimal. This tension distribution has practical sense for the ^ 
operation and maintenance of sinking winches mechanism, 
since it lets four cables bear even load and elastic deforma- 
tion, which can extend the cables' lives and help the platform 
keep horizontal during the motion. 



3.2.2 Even Tension Distribution 

In this section , we investigate the relation between even 
tension distribution and the location of center of gravity. This 
relation can be used to guide the designing of the platform to 
make tension distribution as uniform as possible. 

The tension difference can be defined as 
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Fig. 6. Minimal tension difference between cables 



tension distribution (AT m j„ = 0). The farther C leaves from 
the centroid, the larger difference exists. Therefore,center of 
gravity should be designed at the centroid of the platform to 
achieve an uniform tension distribution of cables. 



Substitution of Eqn. <TT~2T > into above equation yields 

AT = [16-zj - (8 + 8Jti - 8k 2 )mg ■ x 4 + 
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The above expression implies that AT is minimal if 14 = 1^ = 
(l+k\ — k2)mgj\. Besides, T4 must be limited in its interval 
to guarantee the positive tension of cables. Therefore, the 
minimum of AT is co-determined by and the interval of T4. 
Let T4£ and I4R be the left and right endpoint of the interval, 
respectively. From the expression of AT, we conclude: 

1) Ar is minimal with 14 = 141 if %\ < 141; 

2) Ar is minimal with 14 = i\ if 141 < X\ < X4r; 

3) Ar is minimal with 14 = X4R if T4 > %4r. 

For example, the sinking winches mechanism has k\ = 0.25 
and k2 = 0.2, which determine T4 lying in the fourth inter- 
val \(k\ — k2)mg/2,{\ — k2)mgj2\ = [0.025mg,0.4mg], thus 
T4 L = 0.025mg and i4 R = QAmg. x\ = (1 + k\ - k^tnglA = 
0.2625mg implies Z41 < x\ < X4R, thus the minimum of A!T 
is obtained with Z4 =z\= 0.2625rag. Substitution of T4 into 
Eqn. (fT2l yields the tension distribution with minimal differ- 
ence as: Ti = 0.3625mg, T? = 0.2375mg, T3 = 0.1375mg and 
T 4 = 0.2625mg. 

To illustrate the the relation of the even tension distri- 
bution and the location of center of gravity (C), we calculate 
Ar mi „ with respect to k\,k2 E (—1,1), and the results are 
shown in Fig. [6] As can be seen, only if C locates at the cen- 
troid of platform (ki =0,k2 = 0), cables can have uniform 



3.3 Adjacent Cables Having Equal Lengths 

For sinking winches mechanism, if adjacent cables have 
equal lengths and all cables are taut, there exists two config- 
urations, i.e., (h — h, h = h, h 7^ '3) and (l\ = I4, h = h, 
h 7^ h)- For these two configurations, the structure matrix 
J T is nearly singular, which will be illustrated by example 
in section The nearly singularity of J T results in the in- 
effective and incorrect convergence of Trust-Region Dogleg 
Algorithm when the algorithm is used to solve the static equi- 
librium equation. To overcome the defect, we firstly simplify 
the spacial sinking winches mechanism as a planar one be- 
cause of the symmetry of its configuration; and then solve 
the forward kinematics of the planar mechanism; finally cal- 
culate the pose of platform and tension of cables from the 
forward kinematics solutions of planar mechanism. 

Without loss of generality, taking the first configuration 
(l\ = I2, h = U, h 7^ ^3) as example, the simplified planar 
mechanism is shown in Fig. [7] This planar mechanism can be 
regarded as the projection of sinking winches mechanism on 
plane yoz of inertia frame. And points A,, B,, i € {1,2,3,4}, 
and C projects at A[, A4, Z?f, and C p ; besides, the pro- 
jections of By and B2 are overlapped, so are B3 and B4. The 
coordinates of projection points in frame oyz are shown in 
Fig- El thus, the geometrical constraints are expressed as 
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where r p and r P are the lengths of projections of CB\ and 
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Fig. 7. Simplified planar configuration 



CB4 on plane yaz, and expressed as r p = sj (1 —kj^b 1 + h 2 
and r£ = ^/(l+k 2 ) 2 b 2 + h 2 . 

To build up the static equilibrium equation of the planar 
mechanism, we need to express the structure matrix jj>, the 
wrench applied on the platform Fp, and tension of cables 
Tp. jj, are defined as: 



and Bj,i E {1,2,3,4}, the structure matrix of sinking winches 
mechanism J T can also be calculated through Eqn. dHJ. Sub- 
stituting J T into Eqn. (£7), the tension distribution of cables 
is calculated by the expression T = (J T ) + ■ F, where (7 T ) + 
is the pseudoinverse of J T . At this point, the pose of the 
platform and tension distribution of cables have been solved. 

4 Program for Solving the Forward Kinematics 

This section present the procedure for solving the for- 
ward kinematics model (i.e., a system of nonlinear equa- 
tions). Except for the three special configurations discussed 
in section |3] forward kinematics models for other configura- 
tions can be effectively solved by Trust-Region Dogleg Al- 
gorithm. This algorithm starts from a guess of solution to 
search for the solution of nonlinear equations. As discussed 
in section [3] there exists at most six sets of reasonable so- 
lutions. Therefore, to get the unique set of solutions in the 
context of the first configuration (see Fig. |3(a)| >, we need to 
provide a proper guess of solution for the nonlinear equa- 
tions. 
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where z\ = (y 1 - y c )z\ - {y\ - b)(z\ - z c ) and z\ = (y4 - 
y c )zA~ {yA+b)(zA~ Zc)\ F P is [0,-m,g,0] T ; T P equals 
[ti2,t34] T , where i\2 is resultant tension of cables and 
0, and T34 the resultant tension of cables and @. Sub- 
stitution of jj>, Tp, and Fp into Eqn. (0 yields the static 
equilibrium equation 
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Equations ( TT3l l and (fl4] i build up the forward kinemat- 
ics model of the planar mechanism. Solving this model 
with Trust-Region Dogleg Algorithm yields the coordinates 
of B p , B P and C p in frame oyz, which are used to deduce 
the coordinates of C and B(,i G {1,2,3,4}, in inertial frame 
oxyz. Since B p is the co-projection of B\ and B2 on plane 
yoz, the coordinates of B\ and Bj_ are B\ = (a,y\,z\) and 
B2 = (— a,yi,zi). Similarly, B3 and B4 are deduced from 
B P as B3 = (— a,y4,Z4) and B4 = (a, ^4,24). And C is im- 
plied from C p as C = (k\a,y c ,z c )- With coordinates of C 



4.1 Guess of Solution 

The solutions of forward kinematics are the coordinates 
of reference points (B[,B2,B3,C) representing the pose of 
platform, and tension of cables (l\ , 12,13, 14)- To get the 
solutions in context of the first configuration, the guess of 
solutions are provided as follows. 

1) With the given lengths of four cables {I\,l2,h,l4), calcu- 
late the average length as l ave = (l\ + 12 + h + h) /4; 

2) Supposing the platform is suspended by four cables with 
equal length l ave , we take the pose of platform and even 
tension distribution of cables as the guess of solution. 



As discussed in section 13.21 if four cables have equal 
length l ave , the coordinates of reference points are B\ = 
(a, b, -lave), B 2 = (-a,b,-l me ), £3 = (-a,-b,-l ave ) and 
C = (k\a,k2b,— lave — h), and even tension distribution of ca- 
bles are denoted as (i\ ,12,13, T4 Re- 
section 12 has elaborated that the forward kinematics 
model is determined by the tension state (tautness and slack- 
ness) of cables, therefore, the guess for tension need to be 
modified according to the tension state. For example, if ca- 
bles 0, and are taut when the platform is in static equi- 
librium, the guess for tension is modified as (Ti ,i2,l3)ave- 

4.2 Traversal Solving Algorithm 

Section lXTI has elaborated that a definite pose of the plat- 
form can not be solved from forward kinematics model if the 
platform is suspend by single cable. Except for the tension 
states that single cable is taut, there still exists eleven ten- 
sion states : six states for two cables being taut, four states 
if three cables are in tension, and one case if all cables are 
taut. Traversal Solving Algorithm can not only indicate the 
tension state of cables, but also solve the pose of platform. 

Try-and-Error is the core idea of Traversal Solving Al- 
gorithm. This algorithm firstly assumes a tension state; and 



then establish and solve the forward kinematics model cor- 
responding to the tension state; finally check whether the 
assumption holds with the solutions of forward kinematics 
model. If the assumption holds, output the solutions; else as- 
sume another tension state, repeat above process until finding 
the tension state of cables. 

An example can illustrate the Try-and-Error progress: 
assume cables and @ being taut when the platform is in 
static equilibrium; Eqn. (0, Eqn. (01 with i = 1, j = 2 and 
Eqn. (0 with T3 = T4 = build up the forward kinematics 
model; solve the model by Trust-Region Dogleg Algorithm 
with the guess of solutions proposed in section |4~Tt calcu- 
late the distances of A3B3 and A4B4, and check whether the 
following inequalities hold: IA3B3I < It,, IA4B4I < I4, Z\ > 0, 
and 12 > 0; if the inequalities hold, output the solutions, else, 
assume another tension state (for example, cables and ® 
are taut), and repeat the Try-and-Error progress again until 
finding the tension state of cables. 

The procedure of the Traversal Solving Algorithm is de- 
scribed as follows: 

(i) Calculate the guess of solution, go to step (ii); 

(ii) If four cables have equal lengths, take the guess as the 
solution of forward kinematics, go to step (viii). Other- 
wise, go to step (iii); 

(iii) Check whether the platform is suspended by single ca- 
ble referring to section [3~T1 If the assumption holds, 
output message "The platform is suspend by single ca- 
ble, an definite pose can't be solved", go to step (viii). 
Otherwise, go to step (iv); 

(iv) Suppose the platform is suspended by two cables, 
which include six tension states: {0,®}, {0><3)}> 
{(D.@}> and {®,@}. For each ten- 
sion state, establish and solve the forward kinematics 
model, and check whether the assumption holds. If any 
of the six assumption holds, go to step (viii), otherwise, 
go to step (v); 

(v) Suppose the platform is suspended by three ca- 
bles, which include four tension states: {0,(2),®}, 
{®,©,@}, {©,©,©}, and {©,©,©}. For each ten- 
sion state, establish and solve the forward kinematics 
model, and check whether the assumption holds. If any 
of the four assumption holds, go to step (viii), other- 
wise, go to step (vi); 

(vi) If adjacent cables have equal lengths, solve forward 
kinematics following the method described in sec- 
tion !3.3l go to step (viii); else, go to step (vii); 

(vii) Solve the forward kinematics model corresponding to 
the tension state that four cables are taut, and go to step 
(viii); 

(viii) Output the solutions, and exit the procedure. 



5 Examples 

In this section, four examples are presented to examine 
the Traversal Solving Algorithm. The lengths of four cables 
are given in Tab. Q] 

In example 1, the lengths of four cables are not equal, 



Table 1 . Lengths of four cables 



Example l\ (m) h (m) /3 (m) I4 (m) 



1 


20 


21 22 


21.5 


2 


20 


20 20.1 


20.1 


3 


20 


20 21 


21 


4 


20.3 20.1 20.5 


20.2 


Table 2. 


Platform pose and cable tension 


Example 


z 


1 
J 


4 


lJ IX 


2.000 


/-\ AAA 

2.000 


1.996 


B\y 


^ A A A 

2.499 


^ C A A 

2.500 


^ A A A 

2.499 


B\z 


-19.999 


-20.000 


-20.299 




-2.000 


-2.000 


-1.999 




2.499 


2.500 


2.499 




-19.999 


-20.000 


-20.099 




-2.000 


-2.000 


-1.995 




-2.499 


-2.403 


-2.499 




-20.099 


-20.981 


-20.000 


C x 


0.500 


0.500 


-0.001 


Cy 


0.700 


2.500 


0.299 


Cz 


-30.038 


-30.198 


-30.170 


Ti (kN) 


39.201 


61.250 


5.856 


t 2 (kN) 


23.520 


38.750 


49.018 


t 3 (kN) 


13.229 








t 4 (kN) 


22.049 





43.126 



the Traversal Solving Algorithm thus check whether the plat- 
form is solely suspended by the shortest cable according 
to the criteria proposed in section lT. 1 .21 And the interval <|> is 
[0,0.715] U[5-565,6.28] rad, where <|> is the rotational range 
that cables ©, ®, and (4) allow the platform freely rotating 
around cable 0. The non-empty of <|> implies that the plat- 
form is solely suspended by cable 0. Therefore, a definite 
pose of the platform can not be solved. As for examples 2^4, 
the intervals <|> are empty. Consequently, the pose of platform 
and tension distribution of cables can be solved with Traver- 
sal Solving Algorithm, and the solutions are list in Tab. |2] 

In example 2, since l\ = h, h = h, and l\ ^ h, adja- 
cent cables have equal lengths. Moreover, all cables are taut, 
since the assumptions that two or three cables are taut do not 
hold. As described in section 1331 the forward kinematics is 



solved by simplifying the spacial configuration as a planar 
one. With the coordinates of reference points B\, B2, B3 and 
C, the structure matrix J T is calculated as 

" 

-0.00002 -0.00002 0.00003 0.00003 
T= -1 -1 -1 -1 

-1.79942 -1.79942 3.19908 3.19908 ' 

1.5 -2.5 -2.5 1.5 
-0.00003 0.00004 -0.00008 0.00005 

The singular values of J T are 5.43464, 4.08118, 1.32388, 
0.00008. Since there exist a singular value (0.00008) clos- 
ing to 0, the J T is nearly singular, which results in the in- 
effective and incorrect convergence of Trust-Region Dogleg 
Algorithm. 

In example 3, even if l\ = h, h = h and l\ 7^ I3, the 
platform is hanged only by cables Q, (2), since cables (J), 
(?) are much longer than ®, (2)- As for example 4, the plat- 
form is hanged by cables Q, (2) and @ when it is in static 
equilibrium. 

6 Conclusions 

This paper examines the forward kinematics and ten- 
sion distribution of sinking winches mechanism. The tension 
state of cables is considered in the forward kinematics model. 
And the tension state affects both geometrical constraints and 
statical equilibrium equations. When the platform is in static 
equilibrium, there exist at most six configurations, i.e., max- 
imum six reasonable solutions exist for the forward kinemat- 
ics model. However, this paper only focus on the solution in 
the context of the first configuration, which agrees with the 
configuration of sinking winches mechanism. 

Traversal Solving Algorithm is proposed to solve the for- 
ward kinematics model. In particular, three special configu- 
rations that cause the ineffective and uncorrect convergence 
of the numerical algorithm are detailed discussed: 

1) A definite pose of the platform can not be solved from the 
forward kinematic model if the platform is suspended by 
single cable; and the criteria is proposed to check whether 
this case happens; 

2) If four cables' lengthes are equal, a definite tension dis- 
tribution can not be obtained from the forward kinematic 
analysis, but the even tension distribution is unique; 

3) When adjacent cables have equal lengths and all cables 
are taut, the forward kinematics can be analyzed by sim- 
plifying the spacial mechanism as a planar one. 

The analysis of forward kinematics yields the pose of 
platform and tension distribution of cables if the lengths of 
four cables are given. With the pose, we can check whether 
the platform collide with the shaft wall, furthermore control 
the lengths of cables to achieve the level and stable motion of 
the platform. To achieve an uniform tension distribution, the 
platform's center of gravity must be designed at the centroid 
of the platform. 



In this paper, the static equilibrium of platform is con- 
sidered in the forward kinematics analysis. Actually, during 
the motion of platform, the inertial force of the platform can 
not be neglected, because the mass of platform take much ac- 
count of the whole mechanism. Furthermore, the mass and 
elasticity of cable play important role in the motion of the 
mechanism. Therefore, the dynamics model of the mecha- 
nism is our future work. 
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